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© Calibration apparatus of angular velocity sensor in self-contained navigational system. 



a© In a self-contained navigational system wherein the location and heading of a vehicle on road are detected 
with the aid of location and heading detection means using map matching, a calibration apparatus of an angular- 
m velocity sensor used in the self-contained navigational system, comprising: 
j2 an angular-velocity detection sensor (15) for detecting a heading of the vehicle; 

O angular-velocity detection means (1) for calculating an angular velocity from an output signal of the angular- 
ly, velocity detection sensor (1 5); 

q integration means (2) for calculating a current heading of the vehicle by integrating the angular velocity and 
(O by adding the integrated angular velocity to the previous heading of the vehicle; and 

q heading correction means (4) for calculating a difference between a heading output ($r) of the integration 
means (2) and a heading output ($e) of the location and heading detection means (3), for calculating a correction 

JJ? value (6$) for correcting the heading output (Or) of the integration means (2), from the difference or accumulated 
value of the difference! and for feeding the correction value (50) back to the integration-means (2): 
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FIELD OF THE INVENTION 

The present invention relates to a calibration apparatus of an angular-velocity sensor (rate gyro) which 
is used in a self-contained navigational system as one of heading sensors. 

5 

DESCRIPTION OF THE PRIOR ART 

A variety of automatic vehicle navigational systems has been developed and used to provide informa- 
tion about the actual location of a vehicle as it moves over streets. For example, one general approach to 

w such navigational systems is known as "dead reckoning", in which the vehicle is tracked by advancing a 
"dead reckoned position" from measured distances and courses or headings. A system based upon dead 
reckoning principles may, for example, detect the distance travelled and heading of the vehicle using 
distance and heading sensors on the vehicle. 

The heading sensor used in dead reckoning may comprise a magnetic sensor or turning-angle sensor. 

75 In the magnetic sensor, a reading error of more than 10* tends to occur due to the distortion of earth's 
magnetism and influence of external magnetic fields, and spurious magnetic fields associated with the 
vehicle have also to be compensated. In the turning-angle sensor, there is used a differential odmeter for 
detecting a difference of rotation between the left and right wheels. Since the turning-angle sensor detects 
the rotation of tires, it has its disadvantage in that there occur errors caused by a change or distortion in tire 

20 radius, slips and the like. 

A running position display device for a vehicle is disclosed in Patent Abstracts of Japan, Volume 10, 
number 247 (P-490) (2303) and illustrates a device for displaying a position of a vehicle by storing in 
advance bearing data by providing a plurality of specified points on a road map and discriminating the 
magnetism of the vehicle from a bearing difference between the measured bearing data and the specified 

25 points when the vehicle has passed through one of the specified points. 

In order to improve the drawbacks, it has been proposed to replace the above described sensors with 
angular-velocity sensors such as optical fibre gyros, vibration gyros and coma-type gyros which detect 
directly rotational angular velocities. For example, in the optical fibre gyro, laser light is transmitted through 
an optical fibre ring in the clockwise direction and anticlockwise direction. If the optical fibre ring is rotated, 

30 then the lights in the both directions become different in time to pass through the optical path. This time 
difference is detected as a phase difference. 

The vibration gyro is one wherein a rotational angular velocity is detected by detecting a change of the 
vibration distribution of a particle vibrating in a container, since the particle disposed in rotational co- 
ordinates is subjected to Coriolis force. 

35 European Patent Application EP-A-0302736 discloses an apparatus for displaying a travel path in which 
the current position of a moving body, such as an automobile, is given on a road map appearing on a 
screen. This form of self-contained navigational system is based on an angular velocity sensor. When the 
integration of angular variations in this system increases by a predetermined amount, the travel trace is 
presumed to change in shape and pattern matching is carried out. This system is based on the need for 

40 reducing the time needed for pattern matching and this is achieved by decreasing the number of roads that 
will be subjected to pattern matching. This system has the disadvantage that it does not have a means for 
correcting a heading. 

The errors involved in the angular velocity detected by the angular-velocity sensor are relatively small. 
However, if an error is involved in an initial heading used in obtaining the angular velocity by integrating the 

45 sensor output, this error will be fixed thereafter. That is to say, even if the detected angular velocity is 
accurate, the distinctive features of the angular-velocity sensor cannot be utilized if the initial heading is 
inaccurate. On the other hand, if the vehicle heading is corrected to match with the heading obtained from 
the magnetic sensor, it will be subjected to the distortion of earth's magnetic field in that place. In addition, 
in a method wherein a vehicle is stopped on a road to match with the road heading on a map, stopping the 

so vehicle is troublesome, and an accurate calibration cannot be performed since the method depends upon 
the position of the vehicle stopped on the road. 

Moreover, there are some cases where an error occurs in the absolute value of an angular velocity 
detected, because of insufficient adjustment and deterioration of the signal processing systems of the 
angular-velocity sensor. That is, the scale factor of the angular-velocity sensor fluctuates. 

55 The error caused by this fluctuation in the scale factor does not appear when the vehicle moves in a 
straight line, but it appears each time the vehicle turns. Therefore, if the vehicle travels a large number of 
curves in the road, errors are then accumulated and interfere with dead reckoning. 
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Accordingly, it is an object of the present invention to provide an improved calibration apparatus which 
is capable of automatically calibrating the output of an angular-velocity sensor which is used in a self- 
contained navigational system using map matching. 

5 SUMMARY OF THE INVENTION 

According to a first aspect of the present invention there is provided a calibration apparatus of angular- 
velocity detection sensor for detecting a heading of a vehicle which is used in a self-contained navigational 
system, the calibration apparatus comprising: 
w angular-velocity detection means 1 for calculating an angular velocity from an output signal of the angular- 
velocity detection sensor 1 5; 

integration means 2 for calculating a current heading of the vehicle by integrating the angular velocity and 
by adding the integrated angular velocity to the previous heading of the vehicle; and 
location and heading detection means 3 which estimates a location of the vehicle from said current heading 
75 calculated by said integration means, a heading obtained by a magnetic sensor 13 and from a distance 
obtained by a distance sensor 14 and which compares the estimated location with road network data 
obtained from a road map memory 10 to obtain an estimated heading (fle) of the vehicle: characterised by 
further comprising 

heading correction means 4 for calculating a difference between said current heading of the integration 
20 means 2 and said estimated heading of the location and heading detection means 3 and integrating said 

difference over a predetermined distance to obtain an error per unit distance, for calculating said difference 

or error per unit distance, as a correction value SB for correcting the current heading of the integration 

means 2, and for feeding the correction value 50 back to the integration means 2 ( said current heading of 

said integration means being corrected by subtracting said correction value from said current heading of 
25 said integration means. 

Preferably, a calibration apparatus as set forth further comprises initial-heading set means 25 for 

setting, when said vehicle starts travelling on a road, an output of said magnetic sensor or a heading of the 

road as an initial heading of said vehicle. According to the calibration apparatus of the angular-velocity 

sensor, the output of the angular-velocity detection sensor 15 is detected at all times and the angular 
30 velocity der/dt is calculated by the angular- velocity detection means 1. The angular velocity de/dt is then 

integrated and the integrated angular velocity is added to the previous heading of the vehicle by the 

integration means 2 to calculate a current heading Br of the vehicle. 

The current heading Br of the vehicle is supplied as base data of map matching to the location and 

heading detection means 3. The heading output Be obtained from the location and heading detection means 
35 3 with the aid of the map matching is inputted to the heading correction means 4, together with the current 

heading Br obtained from the integration means 2. 

The heading correction means 4 calculates the difference between the heading output Br of the 

integration means 2 and the heading output Be of the location and heading detection means 3. 
If necessary, this difference is accumulated over the distances travelled by the vehicle. 
40 The reason that the difference is accumulated is that the accuracy of data is increased, since errors 

resulting from various factors are involved in the difference not accumulated. 

Thereafter, the correction value SB for correcting the heading output Br of the integration means 2 is 

calculated from the difference or an accumulated value of the difference, and Jed back to the integration 

means 2. 

45 Since the integration means 2 corrects the current heading 6r with the correction value SB and the 
corrected heading is supplied as base data of the map matching to the location and heading detection 
means 3, the accuracy of the map matching can be enhanced. 

According to a second aspect of the present invention there is provided a calibration apparatus of an 
angular-velocity detection sensor for detecting a heading of a vehicle which is used in a self-contained 

so navigational system, comprising: 

angular-velocity detection means 1 for calculating an angular velocity from a output signal of the angular- 
velocity detection sensor 1 5; 

integration means 2 for calculating a current heading of the vehicle by integrating the angular velocity and 
by adding the integrated angular velocity to the previous heading of the vehicle; 
55 location and heading detection means 3 which estimates a location of the vehicle from said current heading 
calculated by said integration means, a heading obtained by a magnetic sensor 13 and from a distance 
obtained by a distance sensor 14 and which compares the estimated location with road network data 
obtained from a road map memory 10 to obtain an estimated heading (Be) of the vehicle; characterised by 
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further comprising; 

heading correction means 7 which calculates a first change 6$x between heading outputs 0r obtained from 
the integration means 2 before and after a turning of the vehicle and a second change see between heading 
outputs obtained from the location and heading detection means 3 before and after the turning of the 

5 vehicle, and which calculates a correction value 5$ for correcting the angular velocity of the angular-velocity 
detection means 1 , by performing a predetermined arithmetic operation on the basis of the first and second 
changes sex and see, and which feeds the correction value 5$ back to the angular-velocity detection means 
1 in which said angular velocity is corrected with said correction value. 

Preferably, a calibration apparatus further comprises initial-heading set means 25 for setting, when said 

10 vehicle starts travelling on a road, an output of said magnetic sensor or a heading of the road as an initial 
heading of said vehicle. The calibration apparatus shown in Fig. 2 is similar to that of Fig. 1 except the 
heading correction means 7. 

When the heading correction means 7 has detected a turning of the vehicle, it calculates the first 
change sex (amount of rotation) of the heading output ex and the second change Bee of the heading output 

75 $e before and after the turning. If necessary, these first and second changes are accumulated over the 
distances travelled by the vehicle. The reason that the changes are accumulated is that the accuracy of 
data is increased, since errors resulting from various factors are involved in the change not accumulated. 

The correction value S<t> for correcting the angular velocity of the angular-velocity detection means 1 is 
then calculated with the aid of the first and second changes sex and see ox accumulated values of the 

20 changes, and fed back to the angular-velocity detection means 1 . 

The angular-velocity detection means 1 corrects the scale factor of the angular velocity with the 
correction value se, and the corrected angular velocity is supplied to the integration means 2. Since the 
output of the integration means 2 is supplied as base data of the map matching to the location and heading 
detection means 3, the accuracy of the map matching can be enhanced. 

25 

BRIEF DESCRIPTION OF THE DRAWINGS 

The above and other objects and advantages will become apparent from the following detailed 
description when read in conjunction with the accompanying drawings wherein: 
30 Figures 1 and 2 are block diagrams showing the principles of the present invention; 

Figure 3 is a block diagram showing a self-contained navigational system into which a calibration 

apparatus of an angular-velocity sensor according to the present invention may be incorporated; 

Figure 4 is a block diagram showing the structure of a first embodiment of the calibration apparatus; 

Figure 5 is a flow diagram showing calibrating processes performed by the first embodiment of Figure 4; 
35 Figure 6 schematically illustrates the interval of distances travelled by the vehicle; 

Figure 7 is a block diagram showing the structure of a second embodiment of the calibration apparatus; 

and 

Figure 8 is a flow diagram showing calibrating processes performed by the second embodiment of 
Figure 7. 

40 

DESCRIPTION OF THE PREFERRED EMBODIMENTS 

Referring to Fig. 3, there is shown, a self-contained navigational system into which a calibration 
apparatus of an angular-velocity sensor according to the present invention may be incorporated. The self- 

45 contained navigational system comprises a console 11, a display 12, a magnetic sensor 13, a distance 
sensor 14, an angular-velocity sensor 15, a road map memory 10 for storing map data and the like, and a 
memory drive 16 for reading data from the road map memory 10. The self-contained navigational system 
further comprises a location and heading detecting apparatus 17 which evaluates the probability of 
existence of a vehicle on each road and calculates the location and heading of the vehicle from the 

so evaluation. The self-contained navigational system further comprises a navigation controller 18 which 
retrieves and reads a predetermined range of a road map, drives the display 18 and performs various 
arithmetic controls such as controls of the location and heading detecting apparatus 17. 

The above described console 11 has a keyboard (not shown) which allows a vehicle operator to start 
and stop this self-contained navigational system, and to move a cursor on the picture screen of the display 

55 1 and to scroll the road map displayed on the picture screen. 

The road map memory 10 comprises a mass storage medium memory such as a CDROM, magnetic 
tape and like. In the road map memory 10, the road'map is divided into mesh blocks, and data (map data) 
of route junctions (nodes) to detect a vehicle location at the unit of each mesh block are stored. This road 
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map data are used for graphic display and route calculation. 

The display 12 comprises a CRT (cathode Ray Tube) and a crystalline panel, and displays textual and 
line graphic information such as road maps, vehicle location, recommended routes, vehicle heading and 
distance to an destination. 

The magnetic sensor 13 detects an absolute angle of the heading of the vehicle as it moves over 
streets. 

The angular-velocity sensor 1 5 comprises an optical fiber gyro, but it may comprise a vibration gyro or 
a mechanical type gyro. 

The distance sensor 1 4 is used to detect distances travelled by the vehicle. For example, the distance 
sensor 14 can constitute a vehicle speed sensor which senses the speed of the vehicle, or one or more 
wheel sensors which sense the rotation of the wheels of the vehicle. 

The navigation controller 18 receives information about vehicle locations from the location and heading 
detecting apparatus 17, and displays on the map the current location and destination of the vehicle. More 
specifically, the navigation controller 18 is constituted by a microcomputer (not shown), a graphic data 
processor (not shown) and a picture image processing memory (not shown), and performs the display of 
menus, retrieval of maps, switching of contraction scale, zoom scroll, display of the current location and 
heading of a vehicle, display of an destination or guide spots, and display of the heading and distance to an 
destination. 

The location and heading detecting apparatus 17 integrates the distances detected by the distance 
sensor 14 and the headings detected by the magnetic sensor 13 and angular-velocity sensor 15, and 
calculates the location of the vehicle by comparing the integrated data with the map data that has been 
read by the memory drive 16, and outputs the location and heading of the vehicle. 

Fig. 4 shows the structure of the calibration apparatus of the angular-velocity sensor 15. 

The calibration apparatus comprises angular-velocity detection means 21 for detecting the rotational 
angular velocity of the angular-velocity sensor 15, and integration means 22 for integrating the angular 
velocity each unit sampling times to calculate a heading angle and for adding the heading angle to the 
heading obtained at the previous sampling time to calculate a heading flr at the current time. 

The calibration apparatus further comprises location and heading detection means 23, heading-error- 
amount count means 24, initial-heading set means 25, and drift calibration means 26. 

The location and heading detection means 23 calculates repeatedly the similarity between the map data 
and the estimate location obtained from the heading output of the magnetic sensor 13 and distance output 
of the distance sensor 14, and determines a most probable vehicle location and heading on the road by 
map matching. 

The heading-error-amount count means 24 compares the heading output Br from the integration means 
22 with the estimated heading output 6e (or heading of the estimated road) from the location and heading 
detection means 23, at intervals of unit travel distances 5l show in Fig. 6. If the accumulation of the 
difference between the heading output er and the estimated heading output $e is above a predetermined 
value, then the heading-error-amount count means 24 feeds a heading correcting output back to the 
integration means 22. 

The initial-heading set means 25 sets an initial heading Oo of a vehicle with the aid of the magnetic 
sensor output or heading of the road, when the vehicle starts travelling. 

The drift calibration means 26 calibrates an angular-velocity drift error of the angular-velocity sensor 15. 

The calibrating operation of the angular-velocity sensor 15- constructed as shown in Fig. 4 will 
hereinafter be described with respect to Fig. 5. 

The output dflr/dt of the angular-velocity detection means 21 is calculated in step S1 , and integrated in 
step S2 at intervals of predetermined clock times St. The integrated output is added to the previous heading 
Or' (initial heading is do) to obtain the following present heading Or: 



Next, in step S3, there is obtained the difference between the heading de(li) obtained at every time when 
the vehicle covers the unit travel distance 51 and arrives at a travel location li (i = 1,2, .... and n) shown in 
Fig 6 by the location and heading detection means 23 and the heading Gr(li) that has been obtained in the 




dt + er 1 
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step 2, and in step S4, the difference is accumulated by the following equation: 

In 

s 66j (n) = £ { 6r(li) - 6e(li) } 

li 

The accumulation (50j(n)) is performed over a predetermined distance. Specifically, the accumulation (5flj(n)) 
jo is continued until it becomes a predetermined value. If the accumulation (50j(n)) becomes above the 
predetermined value, it is then stopped. The vehicle covers a certain distance when the accumulation (60j- 
(n)) becomes the predetermined value. The certain distance can be regarded as the predetermined 
distance. 

In step S5, it is determined if is above the predetermined value. If yes, an error per unit travel 
75 distance 51 is calculated by the following equation: 

59j (n) 
n 

20 

The error is subtracted from the heading Or that has been obtained by the integration means 22. This 
heading (or - 5ej(n)/n) is supplied as Or to the location and heading detection means 23, and the map 
matching is continued. If, on the other hand, 60\(r\) is not above the predetermined value, the step S5 then 

25 returns back to the step S1 , and the above described accumulation is repeated. 

Thus, if the accumulation of the difference (error) between the output of the angular-velocity sensor 1 5 
and the heading obtained by the map matching becomes the predetermined value, then by subtracting the 
error from the heading obtained by the integration means 22, the angular-velocity sensor 15 can be 
calibrated so that a correct heading is obtained at all times. 

30 Fig. 7 shows a second embodiment of the calibration apparatus of the angular-velocity sensor according 
to the present invention. 

As shown in Fig. 7, this embodiment is identical to the embodiment of Fig. 4, except that a rotational 
angle error-ratio count means 27 is provided instead of the heading-error-amount count means 24 and that 
the output of the rotational angle error-ratio count means 27 is fed back to the angular-velocity detection 
35 means 21 . 

If the rotational angle error-ratio count means 27 detects that the vehicle heading is rotated above a 
predetermined angle, then it calculates the following- ratio: 



40 | 69r | - | 68e I 

I 60e | 

where j her | is an absolute value of the rotational angle 5flr calculated from the heading output Or of the 
45 integration means 22, and | 60e | is an absolute value of the rotational angle 60r calculated from the heading 
output Be of the location and heading detection means 23. The above described ratio is accumulated each 
time the angle above a predetermined value is detected. If the accumulated ratio becomes above the 
predetermined value, then it is fed back to the angular-velocity detection means 21 as a scale factor 
correcting output. 

so The correcting operation of the scale factor of the angular-velocity sensor 15 will hereinafter be 
described with respect to Fig. 8. 

The output d0r/dt of the angular-velocity detection means 21 is calculated in step S11, and integrated in 
step S12 at intervals of predetermined clock times St The integrated output is added to the previous 
heading 0r' (initial heading is do) to calculate the following present heading Or: 

55 
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er = /-^-dt + 9r' 




Next, in step S13, rotational angles 0r(t - 1) and 0e(t - 1) at the time the beginning of one curve in a 
road has been detected are obtained. The beginning of the curve can be detected, for example, by 

io detecting that the output der/dt of the angular-velocity detection means 21 or the differentiated value 
o^er/dt 2 is above a threshold. Rotational angles er(t) and fle(t) at the time the end of the curve has been 
detected are also obtained. The end of the curve can be 'detected, for example, by detecting that the output 
der/dt of the angular-velocity detection means 21 or the differentiated value d*er/dt 2 is below the threshold. 
The difference between er(t) and er(t - 1) and the difference between fle(t) and ee(t - 1) are obtained as 

j 5 follows: 

SOr = er(t) - 0r(t - 1) 
Bee = fle(t)- ee(t- 1) 

20 If 50 r and Bee are above a predetermined value, then the ratio of the difference between the absolute values 
is calculated by the following equation: 



69r | - | 66e | 



25 | 69e | 

It is noted that the absolute values are used in the calculation of the above described ratio, in order that the 
fluctuations of the scale factors are prevented from being cancelled with each other at the left and right 
30 curves. 

In step S14, the calculation of the ratio is repeated each time the vehicle travels each curve, and 
accumulated by the following equation: 



m | 59r I - | 69e | 
6(J>(m) = E 



I 69e | 

40 In step S15, it is determined if 6<f>(m) is above a predetermined value. If yes, the step S15 advances to 
step 16, in which the scale factor is corrected. The scale factor is corrected by dividing der/dt by the 
following equation: 

45 60 ( m ) 



m 

where 6$(m)/m is an average value of 5$(m) to one curve. The scale factor may also be corrected by 
so subtracting a value obtained by multiplying der/dt by 5$(m)/m, from der/dt. When 5<fr(m)/m is far below 1, 

the result of the former computation is nearly the same as that of the latter computation. 

Therefore, even if the scale factor of the angular-velocity sensor 15 fluctuates, the fluctuation can be 

automatically calibrated by matching with the rotational angle obtained from the map matching each time 

the vehicles travels a curve in a road. 
55 The present invention is not limited to the above described first and second embodiments. For 

example, if the first and second embodiments are used together, the effect of the calibration is further 

enhanced. 
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Claims 

1. A calibration apparatus of an angular-velocity detection sensor for detecting a heading of a vehicle 
which is used in a self-contained navigational system, comprising: 

angular-velocity detection means (1 , 21 ) for calculating an angular velocity (dfl/dt) from an output signal 
of said angular- velocity detection sensor (15); 

integration means (2, 22) for calculating a current heading (0r) of the vehicle by integrating said angular 
velocity and by adding the integrated angular velocity to the previous heading of the vehicle; 
location and heading detection means (3, 23) which estimates a location of the vehicle from said 
current heading calculated by said integration means, a heading obtained by a magnetic sensor (13) 
and from a distance obtained by a distance location with road network data obtained from a road map 
memory (10) to obtain an estimated heading of the vehicle; characterised by further comprising 
heading correction means (7) which calculates a first change (56r) between heading outputs obtained 
from said integration means (2, 22) before and after a turning of the vehicle and a second change (5$) 
between heading outputs obtained from said location and heading detection means (3, 23) before and 
after the turning of the vehicle, and which calculates a correction value for correcting said angular 
velocity of said angular-velocity detection means, by performing a predetermined arithmetic operation 
on the basis of said first and second changes, and which feeds said correction value back to said 
angular-velocity detection means in which said angular velocity is corrected with said correction value. 

2. A calibration apparatus as set forth in claim 1 , which further comprises initial-heading set means (25) 
for setting, when said vehicle starts travelling on a road, an output of said magnetic sensor or a heading 
of the road as an initial heading of said vehicle. 
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